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= Angular velocity of driving motor 
^2 ~ Angular velocity of steering motor 

r = VJheel radius 

R = Radius of circular path of wheel centres 
Rp = Radius of circular path of the vehicle 
Vp = Linear velocity of the vehicle 

C = Centre to centre distance between the motor shaft 
and the driving shaft 
d^ = Pitch cone diameter of the gear 
d2 = Pitch cone diameter of the pinion 
m = Module of the gear 

= Pitch cone angle of gear 
*^2 = Pitch cone angle of pinion 
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ABSTRACT 


The objective of the present work is to design and 
fabricate a teleoperated vehicle which can act as the base 
of a mobile Robot, Accordingly, a three wheeled vehicle 
is designed and constructed. All the vheels are driven and 
steered simultaneously. Separate motors and controls are 
provided for driving and steering. The control system can 
be operated either manually or through a programmed micro- 
processor, The vehicle is designed to take any radius 
of pa th— curvature , The fabricated vehicle is demonstrated 
to move along various prescribed paths thro igh programmed 


control 



CHAPTER 1 


INTRODUCTION 


1.1 Introduction 

The use of the robots in various sectors is increasing 
day by day as they can replace humanbeings in hazardous and 
monotonous jobs, as well as, higher precision, accuracy, 
repeatability and speed can be achieved. 

At present most of the robots in use are of stationary 
type, i,e, their base remain fixed to the ground. Such robots 
are capable of working within a fixed work space which depends 
on the size and configuration of the robots. Such robots can 
work satisfactorily so long as the situation does not demand 
continuous change in the position of v/ corking , However, there 
are certain areas of application where the work-space of the 
robot is not known in advance, in such cases it is imperative 
that robot changes its position in order to perform the job. 
The application of robots in nuclear establishments, under- 
water, deep mines etc, often demands that the robot moves 
bodily to cover a much wider workspace. Such robots v^^iere 
the base cf the robot moves are called mobile robots [1,2] , 

1 .2 Mobile Robots and Teleoperatod Vehicles 

Mobility or locomotion required in a mobile robot can 
be achieved in two ways namely legged locomotion and wheeled 
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locomotion [3]* Design and construction of legged locomotion 
which are essential for uneven terrain are guite involved 
and expensive [4*9 J • For applications on even terrain* 
like factory floors, wheeled locomotion, which is simpler, 
is sufficient. In ivheeled locomotion, as the name suggests, 
wheels are used to achieve the desired motion of the robot, 
when wheeled locomotion is used and v\tiGn the robot has to 
change level, at that time slope can be provided instead of 
staircase [ 5 ]# 

For wheeled robots the motion of the robot can be 
controlled in three possible ways. For a decided path one 
possible method is to use underground wires or floor paints 
along the given path. Corresponding sensors are mounted 
on the robot v^rhich pick up signals and guide the robot along 
that path [6,7] , This method involves more hardware and so 
is not very flexible as it required change of network of 
wires or repainting the floor for changing the path. The 
second method consists of writing a program to control 
the motion of the wheels in order that the robot moves along 
a certain path and reaches the destination. Both open loop 
and closed loop control systems can be used depending on 
the situation. Here processors get the signals from the 
program and actuate the actuators accordingly so that the 
desired path is executed. In this mode, vvith the help of 
sensors, obstacles can be sensed and avoided, by altering 
the path of vehicle, through an appropriate algorithm [sli 



In this approach , fear generating a new pa-^ no change in 
the hardware is necessary, the only requirement is to 
write a new program* The bhird way to control the motion 
of a robot is by teleoperation. In this mode a human 
operator controls the motion of the robot from a distance. 

The operator can view the rc^ot either directly or on a 
screen and can guide the robot to the destination by avoiding 
obstacle, if any, on thK3 way. In this case, no additional 
hardware or software is required for changing the pa-Ui as 
the operator is controlling the motion directly through 
the interface* 

1,3 Objective and Scope of the Present Work 

The objective of the present work is to develop a 
vehicle which can act as the platform of a mobile robot. 

The motion of this platform is to be controlled in two ways 
namely, manual teleoperation and programmed modes, A 
controller using digital circuit is developed fesr manual 
operation mode and an 8085 microprocessor kit is used for 
programming the motion. For taking various paths it is often 
required to divide the total length into a number of 
segments* Accuracy of tracldng various segments is better 
with smaller radius of turning. In the present model the 
minimum radius of curvature is kept at zero. The entire 
operation is carried out in an open loop control scheme* 


The scope of the v;ork is limited to simple paths 
only. No sensors for sensing the obstacles are mounted 
and so there can not be any dynamic generation of path. 

The v^icle is not controlled by the radio signals and so 
the zone is limited by the length and the entangling of 
the wires. The model is demonstrated for 3 different paths 
in the programmed mode. 



CHAPTER 2 


KINEWICS, MECHANICAL DESiaN AND FABRICATION 

2.1 Introduction 

The proposed design is for a three-wheeled vehicle 
with wheels placed s ymrnetrically a t 120'* on a circle. 

All the three wheels are driven simultaneous! y by a motor 
placed at the centre of the platform to give uniform drive. 
While turning all the \Atieels are steered simultaneously 
by a second motor. Because of simultaneous steering the 
minimum radius of turning is zero. 

In the present chapter first the kinematics of 
the vehicle is described. This explains how the change in 
the path of the vehicle results ’.^hen either or both of 
the driving and the steering motors rotate. This is followed 
by the details of mechanical design of the vehicle. Some 
typical arrangements of the ccanponents which are important at 
the fabrication stage are also noted, 

2.2 Kinematics of a Three Wheeled Vehicle 

As already mentioned, the three wheels of the vehicle 
are placed on a circle at 120^* with each other. Figure 2,1 
shows one such wheel and also explains ho'w it is connected 
to the driving motor. _ Tho other two vAieels are connected 
to the same motor in identical fashion. Thus, all the three 
wheels get the same driving (either forward or reverse) 



Steeringj 
Motor 1 


Wheel Shaft- 


Fig. 2.1 Schematic diagram o 
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motion simultaneoUs';ly, The steering motor is also shown 
in the same figure. It should be noted that the steering 
shaft acts as the housing for both the driving and the 
\/heel shafts. Again tho same steering motor is connected 
to all the three i/hoels in an identical fashion. 

The driving snafts are connected to the driving motor 
by a direct belt-pulley drive with unity angular velocity 
ratio. The wheel shafts are connectea to the driving shafts 
again with unity angular velocity ratio through bevel gearing,- 
Hence if the angular velocity of the driving motor is , 
the linear velocity of the centre of the wheels and that of 
the platform is given by co^r where r is the radius of the 
wheels , 

As indicated in Figure 2.1, the wheels are offset 
from the driving shaft a /is by a distance r equal to the wheel 
radius [s] , With this eccentricity, it is obvious that 
if only the steering motor is given one rotation while the 
drivir© motor is kept stationary then all the wheels come 
back to their original position without any movement of the 
platform. Of course each wheels rolls one full circle around 
its corresponding driving shaft axis and at the sane time 
completes one revolution about its own axis. Thus the wheels 
come back to their original location and the orientation. 

For any arbitrary amount of rotation of the steering 
motor with the driving motor stationary, all the wheels change 



their position and orientation in identical manner while 
the vehicle base neither cnanges its position nor its 
orienta tion» 

Let us now consider the movement of the vehicle when 
both the driving and the steering motors are rotated simul- 
taneously at different speeds. For this we consider only 
one of the wheels as all the v,heels have identical motion. 

Let the angular velocity of the driving motor be 
and that of the steering motor be Then the velocity 

of the centre of the wheel due to the driving motor is t^^r 
while that due to the steering motor is (*>23^* A_s both these 
velocities at any instant are in the same direction, the 
magnitude of the resultant linear velocity of the wheel centi 
is ( direction of this velocity is given 

by the direction of the vector 0^2 r where vector r 
represents the eccentricity of the wheel. For constant 
value of ^2 the path traversed by all the wheel centres will 
be circles of radius R(say), vi/hen 

iigR = 
or 

R = 

As explained in Figures 2,2(a) and 2,2(b), for circuT" 
paths of the wheel centres of radius R, the vehicle base moves 


( w + 0) )r 
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r + r 




in a circle of radius 





So finally the linear velocity of the platform is 
obtained as 


Vp = 'I- W2)r (2,1) 

along a circle of radius 


Q 



By choosing different values of and the platfor 
can be moved at different velocities along circles of varying 
radii. It is obvious that with the steering motor stationary 
i,e, 0)2 = "the platform moves along a straight line 
( R -»■ 00 ) , In either case the orientation of the vehicle 
roiaains unchanged. 

2*3 Mechanical Design of the Vehicle 

To determine the torque required to drive and steer 
the vehicle, all the calculations are carried out by assum- 
ing the mass of the vehicle to be 30 Kg, Few simplifications 
are made by considering the worst case and so the actual torque 
requirement is less than that determined f rom this calculation. 
In order to determine the torque, traction required to drive 
the vehicle is to be found. Traction in turn depends on the 
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condition of surface on which the vehicle is supposed to 
be driven. Empirical data are available in the hand book 
'.'hicn are used for car driving. These data are assumed for 
the present case. 

Data given in the hand book [ 10j , 



Kind of Surface 

Traction in 
lb/1 0001b 

Traction in 
N/kg 

(1) 

Hard smooth asphalt 

11 

.10791 

(2) 

Wood paving 

13 

,12753 

(3) 

Good macadem 

17 

.16677 

(4) 

Bad macadem 

22-45 

,21 6-. 44 

(5) 

Cobbles 

26 

,255 

(6) 

Bad cobbles 

upto 110 

upto 1 ,0791 , 


From the aoove data the condition of good macadem 
is used f or the present case. The actual surface will be 
better and hence the torque required will be less than that 
computed. 

For present case the total traction required 
= 0*16677x30 = 5i0 Mt. 

So total torque required for driving 

= traction x r 

o 3,25 
= 5 X ^ = 


0,1626 Nt-m., 



The torque required for steering is equal to that 
for driving, as in both cases the v\fheels are rolling. 

In addition to this there will be inertia torque acting 
which is very difficult to determine. However, depending on 
the desired acceleration this inertia toique can be much 
more than the torque required for traction. Moreover, friction 
torques at various places like belts, bearings etc, also add 
to the requirement. From the list of stepper motors available, 
motor with 1 ,96 Nt-m torque rating is chosen to suffice for any 
future addition on the vehicle. 

Details of Components i 

Each 'vheel assembly has three shafts namely, the wheel 
shaft, the driving shaft and the steering shaft enclosing 
the driving shaft (Figure 2,3), The driving shaft is taken 
of 1 0 mm diameter and corresponding bearing available is of 
size 10 mm~26 ram internal-external diameter [ill , The 
steering shaft encloses the driving shaft and will support 
it at ends with bearings. This shaft is supported on the 
vehicle base with two bearings and so according to the bearing 
size the outer diameter of the steering shaft is kept at 35 mm. 
The wheel shaft is kept of 12 ran diameter and is supported at 
bearing housing by corresponding bearings for the shaft size. 

From the driving motor to the driving shaft the motion 
is transferred by using V belt of 450 mm length and 9 mm 


Driving Motor 
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thickness , Pulleys used are of 30 mm diameter at both 
motor end and driving shaft and to keep the velocity 
ratio as unity. From the driving shaft, the motion is 
transferred to the wheel shaft through a pair of bevel 
gears. Gears are made of aluminium. The velocity ratio 
is kept one and gear PCD is taken as 46 mm and module 2 mm. 

Initially it was decided to use V belts for trans- 
mitting motion from the steering motor to the steerir^ 
shaft, Hov;ever, belts were not transmitting the motion 
effectively and so it ves decided to use bevel gears for 
transmitting this motion as well. Two sets of gears are 
used to transmit the motion mth overall velocity ratio 
unity [12] , From the steering shaft, the motion is directly 
conveyed to the bearirg housing. The bearing housing is of 
circular shape (Figure 2,5) and the v^heel and the _ bevel gears 
are enclosed in the space between supporting bearings in 
the hous irg , 

Calculations are presented in Appendix i for detailed 
design of gears a rd beltsi 

2,4 Mechanical Fabrication 

The vehicle base is made of Aluminium sheets. Two 
50 cm X 50 cm aluminium sheets of 3,2 mm) thickness 

are used for this purpose. Both the sheets are separated 
by 12,5 mm thick spacers. The spacers give additional strength 
to the base and use cf the sheets makes Cutting of slots in the 



7hp s+f=ertng motor is mounted at the centre of the 
base. Bearing housings supporting steering shafts are mounted 
120*^ apart. Oval shaped slots are cut for adjusting tension 
of the belts. The entire assembly of steering bearing housing 
to the wheel is made adjustable so as to slide inv^ard or 
outward. Bolt and nut are used for this adjustment which in 
turn adjust Ihe tension in the belt. Once the tension is 
adjusted then bho steering bearing housing is tightened with 
the base by four, sets of nuts and bolts (Figures 2, 4(a) and 
2,4(b)). 

The bearing housings of wheel bearings are made of 
Aluminium castings and holes for the wheel shaft bearings 
and steering shafts are bored at 90^' with each other 
(Figure 2.5). 

The driving motor is also placed at the centre of 
the base and on the top of the steering motor (Figure 2.6). 
Care is taken to align the shafts of the steering and 
the driving motors. The driving motor is supported on 
the steering motor by means of a hollow cylindrical piece 
having flat surfaces on either sides to fix with both the 
motors as well as the vehicle base. Three slots at 120*“, 
are cut in the cylindrical piece to let the belts and shafts 
of the gears pass through them. This cylindrical piece 
together with the steorir^ motor is connected to the base by 





500 





Fig. 2.5 Bearing housing of wheel shaft. 
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four bolts and is connoctod with the driving motor by four 
screws , 
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CHAPTER 3 

DRIVE COOTROL CIRCUITS FOR VEHICLE MOTION 

3.1 Introduction 

In the vehicle stepper motors are used for giving 
both the driving and the steering motions. By controlling 
the speed and number of rotations of each motor, the effective 
motion of the vehicle can be easily controlled. As already 
mentioned, the vehicle motion is controlled in two modes, 
namely, manual and programmed modes. The present chapter 
describes the principle and method adopted for above modes 
and various circuits used to achieve this purpose. An 
algorithm for controlling the motion of both the motors 
simultaneously using a microprocessor is also included, 

A stepper motor is an electromagnetic incremental 
actuator which converts digital pulse inputs to am log output 
shaft motion, Ihe shaft of the motor rotates by 1 ,8**/ pulse 
and thus has 200 steps/revolution. It has four windings 
which have to be energised, in correct sequence, in pairs. 

By reversing the sequence tne motor rotates in the opposite 
direction. Following table gives the sequencefor both 
rotations. The same sequence is repeated after every 
four stops [13,14,15] , 



TABLE 3.1 


Stop No, 

1 

2 

3 

4 


1 

1 

0 

0 


State of Phase 
II III 


0 

0 

1 

1 


0 

1 

1 

0 


IV 

1 

0 

0 

1 


state of phase fo 
reverse direction 
I II III r 


1 

0 

0 

1 


0 

1 

1 

0 


0 

0 

1 

1 


3,2 Design of Control Circuit and Power Supply 

In the present work initially stepper motors of 
0,687 Mt-m torque capacity and rating of 12Vfand ,67 amp/ phase 
wore used. However, the torque supplied v^Ias found to be 
inadequate. So stepper motors of 1,96 Nt~m torque capacity 
and rating of 12V* and 1,25 amp/ phase are used. 


Povver Suppl y~ 

Two 12V supplies for two motors and one 5V supply 
for the control circuit are used. All three supplies are 
housed in a single unit. Figure 3,1 shows the circuits used 
for these supplies. The 5V supply is also made variable 
for giving different voltages in the range 2~12 V, To get 
uniform voltage level_the regulators 7805 and 7812 are used 
for 5V, and 12V* supplies respectively. Since each motor 
requires high current, power transistors 3055 are used in 12V, 
supplies. For 12V supplies capacitors of high values are used 



FIG. 3.1 


kt diagram for power supply 


Select switch 



FIG. 3.2 





to miniinize the ripple. Figure 3,2 shows the front view of 
power supply giving details of layout of output sockets. 

Control Circuit 

Figure 3,3 is a block diagram of the control system 
used Lo control the motion of each stepper motor and hence 
of the vehicle. As seen from Figure 3,3, the control system 
has four distinct parts. First two parts, namely the riBnual 
controller and the microprocessor are supplying identical 
signals to the translator and the select switch position 
decides the input to the translator. The translator takes in 
these signals and gives four pulses in correct sequence to 
tho stopper motor drive circuit which in turn provides the 
pulses in correct sequence to the motor. First let us 
explain the riBnual controller along with the translator?. 
Thereafter, v\fe take up the micro-p-rercessor part followed by 
the drive circuit. 

Manual Controller and Translator 

Two identical circuits for two motors are used and so 

only one is explained here. The speed of the stepper motor 

given 

depends on the step rate or pulse frequency/by the manual 
controller vhile the direction is controlled by the direction 
signal given by the controller. 

For generating clock pulses, hex schmitter is used [ 1 6j 
This schmitter v\hen connected with capacitor and resistance 
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FIG. 3.3 BLOCK DIAGRAM OF CONTROL SCHEME 




cjivos ihs OGCiIlating signal (pulse) at the output, A 
potentiomet'^" controls the frequency of this pulse and 
lienee the speed cf the motor, A D.P.D.T, svdtch along with 
a start latch and nand gate acts as ON-OFF switch for the 
moto"^ motion by either allowing this pulse to go to the 
translator or by giving no pulse at the nand gate output. 

This pulse along with direction control bit now goes to 
the translator through the select switch. The translator 
converts this one pulse into four pulses of equal frequencies 
but with phase difference so that the correct sequence is 
maintained. It uses two exclusive or gates and two 
D flip-flops. Figure 3,4 is the circuit diagram cf manual 
controller and translator. Two similar circuits are used to 
control motions of both the motors simultaneously. Using 
this controller the speed of the stepper motors can be varied 
from 3 FPM to 66 RPM. 

Microprocessor Based Controller 

In programming mode the signals to the translators 
of both the driving and steering motors come frera the micro- 
processor, When the motion required demands rotation of both 
the motors the microprocessor provides two clock pulses and 
two direction signals. Thus the microprocessor gives four 
bit output to the translators. An 8085 microprocessor kit 
is used for this purpose. The algorithm used to generate 
the signals is shown in the form of a flow chart in Figure 3,5, 







A routine is written v/hich displays on“off status 

r-f both •th'^ Totors and t'vice the steps of foiwvard motor 
regained to be completed. This display routine acts as a 
delay routine. This routine is called N times where M is 
the delay value loaded. After every N times the count values 
of Doth the motors are reduced by one and when any of the 
count value bpccmes zero the clock bit of that motor is 
Change a and the step value is reduced by one. This procedure 
is repeated until the step value reduces to zero. Thus the 
microprocessor controls the motion of both the motors 
sinulta ’^eously. The listing of this routine is given in 
Appendix 2. alorg with the listing of the program for 
different paths [17,18] , Count value of the motors are 
stored in one byte memory for each motor,, this limits the 
ratio of speed of two motors to 256, This ratio can be 
inexT'ased by keeping more bytes for the count value, 

3,3 Design of Drive Circuit 

The sequence of pulse train output of the translator 
are of low level signals and can not drive the motor and 
so a drive circuit is .used to drive the motor.. The function 
of the drive circuit is to accept low level input logic signals 
in the form of a digital pulse train from the translator 
and control the sequence of the high current to the motor 
phases in order to produce the discrete angular motion. To 
turn a motor phase ON, a voltage signal is applied to BC 147 



Oc* 
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tT-ar.',-' 'i, ' 1,0 1 ,f.i it 0*'', This, in seauence, turns ON 

. '’or ana 3UD5 power transistor wh^ch completes 
I'n ciro:-’. oni the current builds up through the motor 
nnase. .Vhen the ipotor phase is turned OFF by charging the 
S'Onnj at "’0-147 transistor base, all three transistors 
are turned Of". At this time the current in the motor phase 
doCviys thiou'ili the flyback diode and thus discharges the 
'lotor phase. Fy repeating this process we can get discrete 
angular notion of the motor shaft. Figure 3*6 shows this 
circuit. Figure 3,7 shws layout of PCB for this circuit. 






CIRCUIT 
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C-I.’'>PTER 4 

f,'S A Discussions 

1 V or i ' ‘p L‘i ‘.1 n'j th€- fabrication, the vehicle was 
s f-*'. rr*'-; . 1,--'- Sob in boJ' the nianual and the programmed 

■ > , . . 

"■r t!,o ronuul mode operation, in order to reach 
rtn leot’T-t'on o / a\oiding the obstacles, the path taken 
,;-s •x^xiK.rir. into a number of segments of straight lines and 
circ’iU arcs. Thus both the path traced and the position 
the ’'c do ’.'em closoJ y monitored and verified, 

fa ihf' o'j-'a. limed mode, the microprocessor kit was 
'.•'ommi’c .O’ to 'n!:e different paths. Program was written 
'or tukin' thmo cjli ferent iiaths, namely, a straight line, 

1 cTCcid*'": p“tl '’’■'d a figure of 3 path. The program listing 
r oi mo a* ovo ''*■ <i''^es "is given in the Appencti >c_2. For moving 
alonp a figure of 8 oath, the motion vi/as carried out in 
^dghtoen steps. The vehicle motion was observed while tracing 
toese paths. 

//hiJe carrying out the experiments, it was found that 

the torque rati ngs of the motors specified by the maker are 

^ot correct. Torque of the motors fall rapidly r/ith increasing 
the rotational speed. So all the experiments were carried 

out at low speed. In the maraial mode, due to limitations 

put by the hardware, the speed ratio of the two motors was 


li.niited to 6 





’’ rrv'T! that the vehicle deviates a little 

*'■ '' . . 1 ’ n . the operation. The driving shafts 

vrr ' T. ' ; ’r j ".a ' h same angular velocity due to 
; '.{•‘'■'’CO In the '^ff'^ctive radii of the pulley and some 
'■■’’'r.. ' O' t! ‘ i'f'ltp, T'^ore v/as some relative motion 

' i " ' irr.fin."' saaft due to slight backlash in the gears 

'uo -■u''ed deviation from the desired path. In 

+ 1'"’ ■ 2 r, i-ai t'udo, the vohjcle can reach a destination by 
font'" 'iJIln lb'* oat! , lio'rever, siixe the operation was 
ca tii.'u out in the open loop in the programmed mode, error 
c'liild rQ be entirely eliminated, 

1 rJ s 'rnbl»>m can bo solved to a large extent by 
uvln, nl'* T'or drive. In order to monitor the motion in 
pTng:,(,ri d i/ouf*, feed back control scheme can be much more 
ut'l v> vu t’u' error can bo compensated by the appropriate 
motion given !■ y th>' soft'^a^o, 
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APPE^DDC 1 


Calculations for Polt ana Gear Drives 

Cdlculot ons are pr^^sonted here for belt and gear 
drives. Since load and toraue acting ts very less, 
oiaphas? s is not given on strei'igth aspect. 


belt Transmission; 

From the motor to the driving shaft. 

Diameter of pulleys = D 2 = SOran 
= ©2 = 71 radian, 

Lenrjti- of belt at outer surface, L = 45 mm 
Centre to centre distance between the pulleys 


C 


^ = 1T7,78 mm. 


Goar Transmission 
(a) From the driving shaft 
Pitch cone diameter 
^/lodulo 

Number of teeth 

Pitch cone angle 

Face width 

Tip circle diameter 


to the wheel shaft 
d^ = 46 mm 

ra ■= 2 mm 

= 23 

= 45° 

= 8 mm 

= d + 2m Cos 
= 46 + 2x2 X Cos 45 

= 48.3 mm; 



Cone distance P. 

1 

Addendum Angle 

Dedendun Angle 

Blank cone Angle 

Roou Angle 

( b) Between the steering motor and the steering shaft. 

In order to keep velocity ratio unity, the gears on 
tho motor and the steering shaft are identical. Gears placed 
at tho end of tho connoctinq shaft are also made identical, 
CalcuJation for one such pair is shown hero. 

Pitch cone diamoter of gear d^ = 57 ,5 mm 

Pitch cone diameter of pinion d^® 27,5 mm 

Jvlodule m = 1 ,25 mm 

Face v\,'idth= 8 ram 

Number of te..th on gear = 46 

Number of tooth on pinion T 2 ~ 

*^1 27 5 

Pitch cone angle of pinion 62 ^ 57^ 



25.6° 
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rit-ch cone anqle of the gear 6^ = 90~ 6 

= 64i4«' 


Tip cir''le diam''ter of the gear 


Cone distance = 

Addendum Angle = 


2 Sin 
ban""^ 


1 

m 

It 


= djj + 2m Cos ^ 

= 57,5+2x1 ,25xCos64 .4 

= 58,58 mm 

= 31 .87 mm 


Dedendum Angle 


= 2.246 
= tan"* 


1 ,2m 

R 


= 2.695 

Blank cone angle for the gear = 64,4 + 2,246 

= 64,65° 

Root angle for the gear = 64, ~ 2,7 

- 61 ,7° 


Blank cone angle for the pinion = 25 i6 + 2,246 

= 27,85° 

Root angle for the pinion = 25,6 - 2,695 

= 22,9° 



APPENDIX 2 


LISTING OF PRaGRAJ'.iME 


ADDRESS 


CODE 


MNEivlONIC 

REMRKS 

FE90 

3E/80 


RUNS 

MVI A, 80 

Initialise 8255 in 

FE92 






node 0 with B as 

D3 

03 


OUT 

03 

output port 

FE94 

2A 

02 

FF 

LHLD 

FF02 

COPY COUNT VALUES 

FE97 

22 

OA 

FF 

SNLD 

FFDA 


FE9A 

AF 



XRA 

A 

Initialising 8279 

FF9b 

D3 

19 


OUT 

19 


FE9d 

FEAO 

21 

04 

FF 

LXI 

H,FF04 

Steps for F/W motor 
in D-E pair 

5E 



MOV 

E,M 

PEA1 

23 



INX 

H 


FEA2 

56 



MOVE 

D,M 


TEAS 

23 



INX 

H 

Steps for CR motor 
in B-C Pair 

: .‘Al 




MOVE 

C,M 


FEA5 

23 



ITCC 

H 


FEA6 

46 



MOVE 

B,M 


FEA7 

13 



INX 

D 


FEA8 

03 



IN}C 

B 


FEAD 

C3 

00 

FE 

JMJ> 

START 

JUMP TO MAIN 


ROUTINE 

MIN ROUTINE 


FEOO 

CD 

00 

FC 

ST ART; CALL DELAY 

FE03 

21 

09 

FF 

LXI H,FF09 

FE06 

7E 



MOV A,M Get ON OFF Status 




26 

03 


ANI 

03 



X 2 

03 


CPI 

03 

If both motors to 







be off then return 

t-'ROF 

23 



INX 

H 

If count of F/W 







exhausted then call 

1 '■ Ci 

35 



DCR 

M 

service routine 

1 : 

CC 

30 

FE 

CZ 

F/W SRVC 


13 

23 



INX 

K 

If count of CR 







exhausted then 

1 E 1A 

35 



DCR 

M 

call service routine 

1-2 13 

CC 

60 

FE 

CZ 

RIV SRVC 


L E 1 0 

C3 

00 

FE 

JMP 

START 


'•E 90 

C9 



STOP ; RET 

Return to main 


program 


SERVICE ROUTINE FOR FORWARD MOTOR 



30 

1F 



F/W 

SRVC; RAR 

Check if ON OFF 

FLAG BIT IS 1 

i C 

i1 

DA 

48 

FE 

JC 

F/W OFF 


FE 

34 

3i2 

02 

FF 

LDA 

FF02 


FE 

37 

77 



MOV 

M,A 


CIT 
i i 

38 

IB 



DCX 

D 


FE 

39 

7A 



MOV 

A,D 

Check if number of 
steps for F/W 

FE 

3A 

B3 



ORA 

E 

motor exhausted 

FH 

3B 

CA 

50 

FE 

JZ 

F/E FINISH 

JUMP F/W FINISH 

FE 

3E 

3A 

08 

FF 

LDA 

FF08 

Flip the bit for 

F/W Clock and output 

FE 

41 

EE 

80 


XRI 

80 

the result 

FE 

43 

32 

08 

FF 

STA 

FF08 


FE 

46 

D3 

01 


OUT 

01 


FE 

48 

C9 



F/W 

OFF; RET 









b/iV FINISH? 


FF 

, 0 

3A 

09 

FF 

LDA, FF09 

Change ON-OFF 

* n 

53 

F6 

01 


ORI 01 

flag bit 

i £ 

5 b 

32 

09 

FF 

STA FF 09 


“» r*« 

r t: 

58 

C9 



RHT. 






SERVIOE 

rolttim: 

: FOR STEERING 

MOTOR 

FE 

60 

3A 

09 

FF 

LDA 

FF09 

Oheck ON-OFF flag 








bit 

FE 

63 

1F 



RFFL 



FE 

04 

IF 



FAR 



FE 

65 

DA 

70 

FE 

JO; OR OFF 


FE 

68 

3A 

03 

FF 

LDA 

FF03 

Reload count 

FE 

63 

77 



MOV 

M,A 


FE 

60 

OB 



DCX 

B 


1 E 

6D 

78 



MOV 

A,B 

Check if number of 








steps for car mor 

FE 

6E 

B1 



ORA 

0 

exhausted 

Ft 

6F 

c;^ 

80 

FE 

JZi 

OR FINISH 

JUMP CR FINISH 

FE 

72 

3A 

08 

FF 

LDA 

FF08 

FLIP the bit for 








CR clock and out- 

FE 

75 

EE 

02 


XRI 

02 

put the result 

FE 

77 

32 

08 

FF 

STA 

FF03 


FE 

7A 

03 

01 


OUT 

01 


FE 

70 

09 



OR OFF; RET 






OR FINISH ; 


FE 

80 

E5 



PUSH 

! H 

Change “ON-OFF 








Flag bit 

FE 

01 

3/i 

09 

FF 

LDA 

FF09 


FE 

84 

21 

OD 

FF 

LX1 

H , FFOD 


FE 

87 

B6 



ORA 

M 

r 








' ^ •-L'C4h 
























/A^SyQuj 











FF09 


FE 88 

32 09 FF 

STA 

8B 


POP 

L£ 8C 

C9 

RET 


DISPLAY ROUTINE 


FC 

00 

C5 


PUSH 

BC 

FC 

01 

2A 

00 FF 

LHLD 

FFOO 

FC 

04 

44 


MOV 

B,H 

FC 

05 

4D 


MOV 

C,L 

rc 

06 

26 

FC 

IVWI 

H, FC 

FC 

88 

3E 

90 

RPT; 

MVI A 

rc 

OA 

D3 

19 

OUT 

19 

FC 

CC 

7A 


MOV 

A,D 

FC 

OD 

E6, 

FO 

AN1 

FO 

FC 

OF 

IF 


RAR 


1C 

10 

IF 


RAR 



11 

1F 


RAR 


rc 

12 

1F 


RAR 


FC 

13 

2E 

60 

MVI 

L,60 

rc 

15 

85 


ADD 

L 

FC 

16 

6F 


MOV 

L,A 

FC 

17 

7E 


MOV 

A,M 

FC 

18 

D3 

18 

OUT 

18 

FC 

1A 

Ik 


MOV 

A,D 

FC 

1B 

E6 

OF 

AN1 

OF 

FC 

ID 

2E 

60 

MVI 

L 60 

FC 

1F 

85 


ADD 

L 


Initialise 8279 


Display first bit 
of steps 


Display second bit 
of steps 



DISPLAY Third bit 


rc 

20 

6F 



MOV 

rc 

21 

7E 



MOV 

. c 

22 

D3 

18 


OUT 

FC 

24 

713 



MOV 

FC 

20 

E6 

FO 


AN1 

rc 

27 

1F 



EAR 

FC 

2C 

1F 



RAR 

FC 

29 

IF 



RAR 

FC 

2A 

IF 



RAR 

FC 

?B 

2E 

60 


MVI 

FC 

2D 

85 



ADD 

FC 

2E 

6F 



MOV 

IC 

2r 

7E 



MOV 

rc 

30 

D3 

18 


OUT 

FC 

32 

7B 



MOV 

FC 

33 

E6 

OF 


ANI 

FC 

35 

2E 

60 


MVI 

FC 

37 

85 



ADD 

r C 

38 

6F 



MOV 

FC 

39 

7E 



MOV 

FC 

3A 

D3 

18 


our 

FC 

3C 

3A 

09 

FF 

LDA 

FC 

3F 

6F 



MOV 

FC 

40 

1F 



RAR 

FC 

41 

IF 



RAR 

FC 

42 

3E 

03 


MVI 

FC 

44 

D2 

49 

FC 

JNC 


L,A 

A,M 

18 

A,E 

FO 


L,60 
L 

L,A 
A,M 
18 

A,i; Display forth bit 

OF 

L,60 
L 

L,A 
A,M 
18 

FF09 
L^A 

A, 03 
zero 


Display for 
direction 



PC 

47 

3E 

4F 


lvIY1 

A,9F 

PC 

/ 1 9 

O'- 

18 


Zero 

; OUT 

t-C 

4R 

7D 



iMOV 

A,L 

PC 

4C 

IF 



RAR 


rc 

4D 

3E 

03 


MV1 

A, 03 

PC 

4F 

D2 

54 

FC 

JNL 

ZR 

rc 

5? 

3E 

9F 


iViVM 

A,9F 

PC 

54 

D3 

18 


ZR; 

OITT 

PC 

56 

OB 



DCX 

B 

r-c 

57 

78 



MOV 

A,B 

FC 

58 

B1 



ORA 

C 

PC 

59 

C2 

08 

FC 

JNZ 

RPT 

FC 

5C 

Cl 



POP 

BC 

PC 

5D 

C9 



RET 



Display for 
direction 


Ty\BLE FO'l DISPLAY 

Display code for 


FC 30 

03 

0 

FC 61 

9F 

1 

FC 62 

25 

2 

PC 63 

OD 

3 

FC 54 

99 

4 

FC 65 

49 

5 

FC 66 

41 

6 

FC 67 

IF 

7 


rc 68 


01 


8 



9 


X 0 



09 

-c 6A 

11 

PC 6C 

Cl 

PC 6C 

63 

?C 6D 

85 

FC 6F 

61 

FC 5F 

71 


PROGRAi^ 


x^D 00 

31 

60 

FF 

PRCG; LXI SP FF60 


FD 03 

21 

70 

00 

LX1 H 0070 

LOAD DELAY 

fD 06 

ZjL 

00 

FF 

SHLD FFOO 


FD 09 

CD 

70 

FC 

CALL SIR 

CALL SIR 

t-D CC 

CD 

8A 

FC 

CALL CHC 

CAL CRC 

FD OF 

21 

02 

08 

LX1 H 0802 

LOAD COUNT 

- I'^ 

22 

02 

FF 

SHLD FF02 

VALUE 

FD 15 

21 

90 

01 

LX1H 01 90 

LOAD STEPS F/W 

FD 13 

22 

04 

FF 

SHLD FF04 

FD ID 

21 

64 

00 

LX1 H 0064 

LOAD STEPS CR 

FD 1£ 

22 

06 

FF 

SHI,D FF06 


FD 21 

CD 

61 

FD 

CALL R1 


FD 24 

00 

00 


NO OP 


FD 26 

21 

00 

02 

LXI H 0200 

LOAri OUTPUT 

FD 29 

22 

08 

FF 

SHLD FF 08 

CONTROL 

FD 2C 

CD 

90 

FE 

CALL RUN 




■4 *.1 

21 00 01 

O 

o 

o 

X 

LOAD OUTPUT 

I 3 3C 

22 08 FF 

SICDF F 08 

CONTROL 

"D 3: 

DD SO FD 

CALL R3 


ID 3G 

3E 08 

1^1 A, 08 

LOAD COUNT 

^‘D 3A 

32 03 FF 

STA FF 03 

VALIE 

FD 3D 

CD 90 FD 

CALL R4 


FD 40 

CD 90 FD 

CALL R4 


FD 43 

CD 90 FD 

CALL R4 


FD 46 

CD 90 FD 

CALL R4 


FD 49 

21 FF 01 

LXt H 01 FF 

LOAD OUTPUT 

:-D 4C 

22 08 FF 

SHLD FF 08 

CONTROL 

FD 4F 

CD 80 FD 

CALL R3 


FD d2 

3E 08 

W A OG 

LOAD COUNT 

FD 34 

32 03 FF 

STA FF 03 

VALUE 

FD 57 

CD 70 FD 

CALL R2 


FD DA 

CD Dl FD 

CALL R1 


FD bD 

CD 61 FD 

CALL R1 



76 





ROUT I ME 


FD 61 

21 64 00 

LX1 H 0064 

LOAD STEPS CR 

FD 64 

22 06 FF 

SHLD FF06 


FD 67 

21 00 02 

LXI H 0200 

LOAD OUTPUT 

FD 6A 

22 08 FF 

SHLD FF08 

CONTROL 

FD 6D 

CD 90 EE 

CALL; RUN 


FD 70 

21 64 00 

LX1 H 0064 


FD 73 

22 06 FF 

SHLD FF 06 




TD 

7o 

21 

00 

00 

LXi 

00 00 

•-D 

79 

22 

08 

rr 

SMLD 

FF 08 

FD 

7C 

CD 

90 

FE 

CALL 

p^m 

r’D 

7F 


C9 


RET 

FD 

80 

21 

C8 

00 

LXI 

H, OOC8 

FD 

83 

22 

06 

FF 

SHLD 

FF 06 

FD 

86 

3E 

01 


W1 

A 01 

FD 

88 

32 

03 

FF 

STA 

FF 03 


83 

CD 

90 

FE 

CALL 

RUN 

fD 

8E 


C9 


RET 


FD 

90 

21 

64 

00 

LXI 

H, 00 64 

FD 

93 

22 

06 

FF 

SI-LD 

FF06 

I D 

96 

21 

FF 

00 

LX1 

H, 00 FF 

FD 

99 

22 

08 

FF 

SHLD 

FF 08 

X D 

9C 

CD 

90 

FE 

CALL 

RUN 

i D 

9r 

21 

FF 

02 

LX1 

H, 02 FF 

rD 

A'y 

22 

08 

FF 

SHLD 

FF 08 

FD 

AD 

CD 

90 

FE 

CALL 

RUN 

FD 

A8 


C9 


RET 

FC 

70 

21 

02 

08 

DC1 

H,08 02 

FC 

73 

22 

02 

FF 

SPtD 

FF 02 

rc 

76 

21 

BO 

04 

LX1 

H, 04 BO 

FC 

79 

22 

04 

FF 

SHLD 

FF 04 

FC 

7C 

21 

C8 

00 

LXI 

H,00 C8 

FC 

7F 

22 

06 

FF 

SHLD 

FF 06 

FC 

82 

21 

FF 

02 

LXI 

H, 02 FF 



r 

33 

22 

08 

FF 

rc 

86 

CD 

90 

FE 

FC 

89 


C9 


PC 

8A 

21 

02 

10 

rC 

8D 

22 

02 

FF 

FC 

90 

21 

60 

04 

PC 

93 

22 

04 

FF 

FC 

96 

21 

00 

01 

PC 

99 

22 

66 

FF 

FC 

9C 

21 

FF 

00 

FC 

9F 

22 

08 

FF 

FC 

A3 

CD 

90 

FE 

cC A6 


C9 



SHLD FF 08 
CALL RUN 
RET 

LXI II, 1002 
SHLD FF 02 
LXI H, 04 BO 
SHLD FF 04 
LXI H, 01 00 
SITLD FF 06 
LXI H, 00 FF 
SHLD FF 08 
CALL RUN 
RET. 








